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ABSTRACT: 

Some  interceptor  missiles  as  presently  formulated  possess  a  programmed 
thrust  magnitude  history  with  a  gimbaled  engine  to  provide  steering.   We 
examine  one  such  missile  to  determine  whether  performance  can  be  improved 
if  we  allow  a  variable  thrust  magnitude  together  with  engine  gimbaling  to 
provide  control. 

Two  trajectory  optimization  programs  were  written  to  provide  an  initial 
answer  to  this  problem.   Preliminary  results  indicate  reductions  in  the  time 
to  intercept  by  as  much  as  thirty  per-cent  over  that  obtained  by  the  pre- 
sently used  guidance  scheme.   With  tuning  of  the  programs  it  seems  rea- 
sonable to  expect  even  greater  improvements  and  further  investigation  seems 
warranted . 
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Introduction 

Some  interceptor  type  missiles  as  presently  formulated  possess 
programmed  thrust  magnitude  history  with  a  gimbaled  engine  to  provide 
steering.   The  present  guidance  scheme  used  on  these  missiles  determines 
the  steering  control  and  hence  the  direction  of  the  thrust  vector.   We 
examine  one  such  missile  and  answer  the  question  as  to  whether  perfor- 
mance can  be  improved  if  we  allow  a  variable  thrust  magnitude  together 
with  thrust  direction  to  be  controlled  by  some  guidance  scheme. 

In  order  to  take  the  first  step  in  answering  this  question,  two 
trajectory  optimization  programs  were  written.   These  were  designed  to 
determine  optimal  histories  of  thrust  magnitude  and  direction  in  order 
to  obtain  minimum  time  to  interception  for  our  missile  under  given 
scenarios.   While  the  programs  are  not  in  a  finely  tuned  state,  neverthe- 
less, preliminary  results  indicate  reductions  in  the  time  to  intercept 
by  as  much  as  thirty  per  cent  from  that  obtained  by  the  present  scheme. 
With  tuning  of  the  programs  it  seems  reasonable  to  expect  even  greater 
improvements  and  further  investigation  seems  warranted. 


Model 


The  missile  model  used  was  two  dimensional  since  all  test  trajectories 
were  flown  in  a  horizontal  plane. 

Letting  the  indicated  terms  have  the  meaning  specified  in  the 
nomenclature,  then  the  picture  of  the  model  is: 


Yo  axi9 


(y2,y4) 


t_ 


y,  axis 


Figure  1 
Missile  Model 


The  differential  equations  for  this  model  are 
la)  y1  =   y2 

lb)   y.  =  TT-FA  cos  AT  -  FN  _ 
2.       —  h- 

y5        y5  i 

lc)  y3  =  y4 

Id)   y .  =  TT-FA  sin  AT  -  FN  _ 
4   —  E- 

y5        y5  2 

le)   y  =  -  TT 


8050 

where  y       y  , . . .  ,y  are  called  state  variables  since  they  define  the  state 

of  the  missile  and  TT,AT  are  called  control  variables  since  they  control 

the  state  through  the  equations  1);  ii)  FA, FN  are  functions  of  the  velocity 

vector  and  the  control  angle  AT. 

The  constraints  for  this  problem  are 

2a)   0  <  TT  <  14400.0 

TF 
2b)   /  TTdt  <  38,500 
0 

in  which  2a)  is  a  thrust  level  constraint  which  says  that  our  thrust  must  be 
non-negative  and  is  bounded  above  by  14400  lbs.  and  2b)  is  a  condition  on  the 
amount  of  fuel  used. 

Our  task  is,  given  the  initial  conditions 

3a)        y,  ,  y9  ,  yq  ,  y,  ,  y. 
0    0    0    0    0 

for  the  missile  and 

•  • 

Jim  >  ^IT  '  ^^T  '  '  ^T 

0     0     0     0 
for  the  target,  then  determine  a  history  of  TT,  AT  in  time  which 


Detailed  equations  are  presented  in  the  Appendix 


yields  a  minimum  for  the  time  of  intercept  TF.   Using  the  penalty  method  to 
include  the  constraint  of  target  impact  in  the  cost  function,  our  cost 
function  is  then 

4)     c  =  tf  +  uN[(yi  -  y1T)2+  (y3  -  y3T)2] 

Method  of  Solution 

A.   General  Techniques  Available 

There  are  many  ways  to  attack  a  problem  of  the  type  specified 
above.   For  example; 

a)  the  classical  calculus  of  variations  technique 

b)  gradient  technique 

c)  conjugate  gradient  technique 

Of  these  a)  is  an  indirect  method,  which  seeks  a  trajectory  which  satisfies 
certain  necessary  conditions  rather  than  seeking  to  reduce  the  cost  function 
directly.   This  method  depends  upon  the  choice  of  the  initial  values  of 
a  set  of  multipliers  called  adjoint  variables  which  satisfy  a  certain  system 
of  differential  equations.   This  choice  is  often  a  highly  sensitive  one  and 
instability  in  attempting  to  converge  to  a  solution  trajectory  can  result. 

Methods  b)  and  c)  are  direct  methods  in  that  they  directly  seek  to 
minimize  the  cost  function  by  seeking  new  trajectories  with  lower  values 
of  cost  function.   All  of  these  methods  are  based  on  generating  a  sequence 
of  trajectories  which  converges  to  the  minimizing  one.   The  gradient 
technique  works  by  linearizing  the  cost  function  at  each  trajectory  of 
the  sequence  developed  and  iterates  to  the  next  trajectory  of  the  sequence 
by  changing  the  controls  in  the  direction  opposite  to  the  gradient.   The 


conjugate  gradient  technique  is  a  step  more  sophisticated  than  the  gradient 
technique  in  that  it  generates  new  trajectories  in  its  sequence  by  effectively 
expanding  the  cost  function  in  a  Taylor  Series  up  through  the  second  order, 
thus  obtaining  a  more  accurate  representation  of  this  function. 

All  of  these  methods  together  with  a  number  of  others  were  considered 
for  the  problem  at  hand  and  because  of  greater  sureness  of  convergence 
the  conjugate  gradient  method  was  selected. 

B.   Brief  Description  of  the  Conjugate  Gradient  Technique 

This  method  is  most  easily  described  when  discussing  the  problem 

of  minimizing  a  cost  function  which  is  a  quadratic  function  of  the  N  variables 

x, , . . . ,x  .   Thus  assume  that  we  are  given  the  problem  selecting  values  of 

x, , . . . ,x  in  order  to  obtain  a  minimum  of  the  quadratic  function 
In 

5)  c(X)  =  d  +  BX  +  1/2  XTGX 

where:  i)  X  denotes  the  vector  (x-,...,x  );  ii)  d  denotes  a  constant  and  B 

in 

denotes  a  constant  vector;  iii)  G  denotes  the  matrix  of  second  partial 
derivatives  of  c.   Given  a  starting  point  X-  the  conjugate  gradient  method 
computes  a  sequence  of  vectors  H-.,  H-  , . . . ,  along  which  the  function  c  is 
minimized.   Thus  starting  at  Xq  the  method  computes  a  direction  H  which 
depends  on  the  cost  function  c  and  the  point  X_  and  determines  a  value  X 
which  is  a  minimum  of  c  in  that  direction.   Next,  a  direction  H  is 
computed  at  X-  and  c  is  minimized  along  that  direction  to  produce  the  point 
X_.   The  sequence  continues  in  this  manner  and  it  can  be  shown  that  in  the 
absence  of  round-off,  the  method  will  converge  to  the  minimum  point  in  at 
most  N  iterations  (where  N  is  the  dimension  of  the  vector  X) . 


In  general,  as  in  our  case,  the  cost  function  is  not  quadratic.   The 
procedure  then  is  to  approximate  the  cost  function  by  the  first  three  terms 
if  its  Taylor  Series  at  each  iteration  point  so  that  it  has  the  form  of  a 
quadratic  and  to  develop  the  directions  H  from  those  approximations  as 
outlined  above  for  the  quadratic  case.   Details  of  the  conjugate  gradient 
method  as  originally  developed  by  Hestenes  for  linear  systems,  are  in  [1] 
and  its  application  to  general  functions  is  explained  in  [2].   Furthermore, 
the  technique  of  conjugate  gradients  works  on  more  general  functions  than 
functions  of  a  finite  number  of  variables  and  one  may  apply  it  with  some 
modification  to  functions  of  an  infinite  number  of  variables  (see  [3]). 
Thus  for  a  cost  function  which  depends  upon  an  infinite  number  of  variables 
as  our  cost  function  which  depends  upon  the  value  of  TT  and  AT  at  each 
time  point,  one  may  use  this  technique  to  seek  out  those  values  which 
minimize  it. 

C.   Application  of  the  Conjugate  Gradient  Technique  to  Our  Problem 

In  order  to  apply  the  conjugate  gradient  technique  to  our  problem, 
two  computer  programs  were  written. 

The  first  of  these  programs  was  written  using  the  conjugate  gradient 
technique  for  an  infinite  number  of  variables  as  referred  to  above.   This 
program  is  listed  in  the  Appendix  B  and  was  never  fully  checked  out  due  to 
lack  of  time. 

The  second  program  was  written  using  the  conjugate  gradient  method 
for  functions  of  a  finite  number  of  variables  as  outlined  above.   Now  as 
previously  stated,  the  cost  function  for  our  problem  depends  upon  infinite 


dimensional  controls,  namely  the  magnitude  TT  and  direction  AT  of  the  thrust 

vector  at  each  time  point.   However  in  any  computing  machine  procedure  for 

integrating  the  differential  equations  for  our  problem,  only  values  of 

the  controls  TT  and  AT  at  a  finite  number  of  time  points  are  used.   For 

example,  in  the  simplest  type  of  integration  scheme,  if  the  time  interval 

is  denoted  by  DT  and  t  ,  tn ,  t„,...t,...  are  the  time  points  of  the 

o   1   2     j  r 

integration  scheme  then 

y(t1)  =  y(tQ)  +  y(t0).DT 
6)         y(t2)  =  y(t1)  +  y(t1)-DT 

y(ti+1)  "  y(tJ  +  y(t.)-DT 

y(TF)  =  y(TF-DT)  +  y(TF-DT)-DT 

where  y,y  denote  the  state  variable  to  be  integrated  and  its  derivative  and 
TF  denotes  the  final  time.   In  this  scheme  only  the  values  of  TT  and  AT  at 
the  time  points  t.  affect  the  trajectory.   Thus  our  cost  function  which 
depends  upon  y  at  the  final  time  in  turn  also  depends  on  the  values  of  TT 
and  AT  only  at  these  time  points. 

Thus,  the  computer  really  reduces  the  infinite  dimensional  problem 
to  a  finite  dimensional  one.   Furthermore  if  we  take  this  into  account 
in  formulating  our  model  then  our  numerical  optimization  scheme  which  must 
abide  by  such  shortcomings  of  the  computer,  will  be  surer  of  success. 

This  then  is  the  technique  used  to  adapt  the  finite  dimensional 
conjugate  gradient  method  to  our  problem.   The  integration  scheme  selected 
is  the  one  used  on  already  existing  trajectory  computer  programs  for  the 
missile  under  consideration  and  is  as  follows: 


7) 


yl Ct j+1 

y2(Vl 
y3Ctj+l 
y4(tj+l 


-  y.Ct.)  +  f,(t  )-DT  +  f,(t.)-DT2 
J     J-  j        z  j   2 

=  y2(t.j)  +  f2(t  )-dt 


=  y  Ct.)  +  f.Ct.)-DT  +  f  (t.)DT' 

-J    j         -J    J  ^    J   o 

-  y^V  +  f4Ctj),DT 

=  yjCtj)  +  f5Ct.j).DT 


where  we  have  denoted  by  f  i  =  1 5  the  right  hand  sides  of  1).   This 

integration  scheme  essentially  integrates  the  position  components  y  and  y~ 
by  using  the  first  two  derivatives  of  position,  while  integrating  the 
velocity  components  y~,  y,  and  the  mass  y  by  using  only  the  first  deri- 
vatives of  these  quantities. 

Besides  computation  of  the  cost  function  at  each  iteration  point,  the 
conjugate  gradient  method  requires  us  also  to  compute  the  derivative  of 
the  cost  function  with  respect  to  the  control  variables  TT(t.),  AT(t  ). 
By  the  chain  rule  for  differentiation,  this  requires  that  we  first 
differentiate  the  cost  with  respect  to  the  state  variables  at  TF  and  then 
differentiate  the  state  variables  at  TF  with  respect  to  the  controls  at 
the  times  t..   The  former  derivatives  are  easily  formed,  however  the  latter 
derivatives  are  formed  sequentially  as  follows:   According  to  the  inte- 
gration scheme  7)  forming  the  derivative  of  y  (i  =  1,...,5)  at  t«  with 
respect  to  AT(tQ)  and  TT(tQ)  yields 


8) 


3AT(tQ) 


=  0 


3TT(tQ) 


i  =  1,...,5 


10 


Forming  the  derivative  of  y.  at  t  with  respect  to  AT(t  )  and  TT(t  )  yields 


9a) 


3AT(t1) 


=  0 


3TT(t1) 


=  0 


1 5 


and  next,  forming  derivatives  with  respect  to  AT(t  )  yields 


frj^   9yi(t0)  ,fl  »W  3yj(t0)   3fi<V 
3AT(tQ)    3AT(tQ)   L^  3yj  CtQ)  3AT(tQ)  +  3AT(tQ) 


•DT 


8fi(t0) 
3AT(tQ) 


•DT  i  =  2,4,5 


9b) 


3AT(tQ) 


3AT(tQ) 


5 


iv  0 


0J 


3f.(t0) 


>!  *Vfy)    3AT(tQ)    3AT(tQ) 


DT 


»f1+1(t0)  ay^^) 


AW 


3AT(tQ) 


8fi+l(t0> 
3AT(tQ) 


DT 
2 


3W 

3AT(tQ) 


DT  + 


5fi+l(t0> 
3AT(tQ) 


DT 
2 


i  =  1,3 


where  the  last  equalities  in  9b)  result  from  9a)  and  where  f.(t,)  means  the 
function  f.  evaluated  with  arguments  y(t,  ),  AT(t  ),  TT(t-).   Similar  equations 
hold  for  the  derivatives  with  respect  to  TT(t..)  and  TT(tn).   Continuing  in 
this  fashion,  then  at  time  t,  we  form  the  derivatives  of  y.(t,)  with  respect 
to  TT  and  AT  at  all  time  points  up  through  t,  .   Forming  the  derivatives 
with  respect  to  AT  at  all  such  times, first  we  set,  (as  in  9)  the  derivative 
with  respect  to  AT(t,  ) 


11 


10a>  7m^-°  i  =  1 = 

while  for  the  derivative  with  respect  to  AT  at  the  immediately  preceeding 
time  point  t,  _. 


iob)        ayi(tk)    af±(Vl) 

BATCt^)  "  3AT(tk_1)   Di     X  "  2'4'5 


8yi(tk}        _  8fi(Vl)    .  nT  +  3Wfck-l>      DT2 

aATCt^p   aATCt^)   Ui  +  3AT(tk_1)    *  2      i  -  1,3 

and  finally,  for  the  derivative  with  respect  to  AT  at  all  other  preceeding 

time  points   t    ,s  =  0,1,... k  -   2 
s 


i(V     3yi(tW  ,   f  ^Va>   ^  (\-i> 

T(ts)    ■   3AT(ta)  jil^jCVl5      3AT(ts)        °T        X  "  '" 


DT 


^V    Wi*  +  5y  9fi(tk-i>  »Wi> 

1UC;  9AT(tg)  "    3AT(ts)  -jfi    ^j(tk_l)      3AT<V         ' 

+     I  3WVl>  3yj  < Vl>        DT2 

j=i  ^(t^)  3AT(ts)      '     2 


with  similar  equations  holding  for  the  derivative  with  respect  to  TT  at 
all  time  points.   It  is  recognized  that  all  derivatives  of  the  state  y 
required  on  the  right  hand  side  of  10)  have  already  been  formed  at  previous 
steps  in  the  process. 

This  procedure  continues  until  we  reach  TF  and  thus  obtain  the 
required  derivatives  of  final  state. 


12 


Since  the  cost  function  also  depends  upon  TF,  we  are  also  required  to 
form  the  derivative  of  the  cost  with  respect  to  TF,  however  this  presents 
no  difficulty. 

Results 

In  stating  the  results  of  using  the  above  described  computer  program, 
it  is  to  be  noted  that  there  were  severe  time  limitations  on  this  initial 
phase  of  the  project  so  that  only  a  minimal  amount  of  time  was  left  after 
formulation,  development  and  checkout  of  the  basic  computer  program. 
Consequently,  the  results  presented  herein  are  preliminary  in  the  sense 
that  no  "tuning"  (such  as  problem  scaling)  of  the  computer  program  to 
this  problem  was  done.   Such  tuning  will  produce  better  and  often  very 
significantly  better  results  than  the  basic  program.   Nevertheless,  the 
results  that  were  obtained  indicate  significant  savings  in  time  over  those 
obtained  from  the  presently  used  guidance  scheme. 

The  basic  missile  target  scenario  that  was  used  had  the  target  at 
20,000  feet  initial  range.   Both  missile  and  target  had  initial  velocity 
of  800  feet  per  second.   The  missile  heading  and  target  aspect  were  varied 
as  depicted  by  dashed  lines  in  the  figure  below. 
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Figure  2 
Basic  Missile-Target  Scenario 


The  results  of  the  conjugate  gradient  runs  together  with  a  comparison 
to  the  results  of  the  presently  used  guidance  scheme-  are  presented  in  the 
table  which  follows.   In  addition,  plots  of  some  of  these  comparison 
trajectories  are  also  presented.   In  each  plot  is  indicated  the  time  of 
intercept  with  the  target.   Finally,  the  values  of  the  control  variables 
TT  and  AT  at  each  time  point  t,  are  listed  for  each  plot.   The  number  of 
such  time  points  or  equivalently  the  number  of  intervals  in  the  integration 
process  is  arbitrary  and  was  generally  selected  to  give  roughly  an  interval 
of  .25  sec  for  the  initial  trajectory  and  time  of  flight  which  were  used 
to  start  the  program  for  each  case. 
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y    (feet  x  10   ) 


C-J 
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History  of  Thrust  Magnitude  (lbs.)  and 
Direction  (Radians)  at  Each  Time  Point 


Missile  Heading  -90° 
Target  Aspect    90° 

THHUST  USED     A,\JGLK  USED 

-4 .605009  591 450599E-06    4.723  1  8  1  593^  80.707 
1  4,399.99997933809     .3859842903584423 
14399.99997969224     .380-3681  1  171  61034 
14399.99998002896     .37^756521  4444642 
14399 .99998032638     .374883  55/116  79647  . 
1  4399  .9999* 060686     •  37480689t>s;''-!::638^ 
14399 .999980874    .3739137777922477 
14399.999981 17321     .3716830*58999721 
14399.99998147072     .3662140979628795 
14399.99998178906  ■    .361  1019836.883072  • 
14399.9999821 3868     .3562308881 01 1089 
14399  .99-V98?  53284     .3  5161.44827031929' 
14399.999982  9  8  8  5  8     .3  47  2  2  3_30  4 .6. 2  3. 1528 
14399 .99998352771     .3429874251066726 
14399.99998417795     .3387945142194222 
14399.9999849742      .3344809309495753 
-1 .484! 354001 74 198E-05    .339533  7541740675 
-1 .367361742331 171 E-05    -3383031815255845 
-1  .29:v-m;1  O5470S595E-0-5    .3374743729385739 
-1 .201 623031 575876E-05    .336939188427191 
-1  .1 125974413746&VE-05    .336625.99840168  >9 
-I   .OS6102?  I  •  4681  ;:  -'>•;    .''•■:•■  '.07010192663 
-9.421  1664930391  55E-06   '.33649044841  78623 
-8.606247083233835E-06    .33661568  14075165 
-7.8161166  53  9  9  1  8  0  6E-0  6    .336  .r'.  4  9  7  5 1-  5  6 1  40  6  4 
-7.050653059250109E-06    ...33718591  1259483 
:-6«309754339144073K-Q6    .3376216675022808 
-5.593337347902797F-06    .3381581899218649 
-4.90133683683831  5E-06    .3387996661  786958 
-4 .23370489874 5038E-06    .339  55892217  52953 
-3.59041071 3869574E-06    .3404271763094834 
-2.971 440567082996E-06    .341433874412035 
-2 • 37  6798 1 8 8 1 00  54 1 E-0 6    . 3  42 56  6  560 44  73 1 3 6 
-1  .80650501 1774549E-06.   .343.9007378455418 
-1 .260601 66 140531 4E-06    .345393669010457 
-7 .391 486353900 189E-07    .3470840440900613 
-2.482884241  523481E-07    •348991  42 19.49  40  M 
V0      .3500000000003638  *" 
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/History  of  Thrust  Magnitude    (lbs.)    and 
Direction   (Radians)    at  Each  Time  Point 


Missile  Heading  -90 
Target  Aspect       180 


o 


IHrfCJST  USED     ArtGLE  USED 

-1  .16466681 5255909E-05    4.723242003744533 
14399. 999 980? 70 3 9     6  .47925229493 7 59 7E-02 
14399.999980*756/1     6  .335285438950643E-02 
1 4399.99998068814     6.437690961 88719E-02 
1 4399 .9999807254      6.7971 36202 1 1 3957E-02 
143  99.9  9  9  ?  8080467     7.415169758  0  4  9  9  5  5  E  -  0  2 
14399.9999809  561 6     7  .622122  700236574E-02 
1 43  99 .9999811 2 4 u  5     7  .7008  7  63662 12161 £-08 
1 4399  .99998 132 1 52     7 .8285094882961 93E-02 
1 4399  .99998155864     8.014004523567484E-02 
14399.99998185297     8 .273575855923544E-02 
14399.99998222689     8  .6328254731 8824SE^02 
143  99.99998270  991     9  #_1 3 1  522395380891  E-02 
14399.99998334048     9  •8'32592525874304E-:02 
1 4399 .999984 1 68  03     . 1083  9  582  7440  5448 
-1  .566/(93161  176776E-05    7 .969501 83 133419E-02 
-1 .4602  7  493 547 52 38 £-0  5    7 . 59503741 96 7636E-02 
-1  -357041 566137291 E-05    7 -301 4551 4555067SE-02 
-1  .256871 182486963E-05    7 .06795697486307E-02 
-1  .1 59822829443353E-05    6 .8781 89976333292E-02 
-1  .0659421870431 55E-05    6 .71 91 48077368842E-02 
-9.752657448003086E-06   '  6 . 58020 1 44598051 6E-02 
-8.87823856391 4252E-06    6 .45231 5951 794057E-02 
-6. 03643002201 6277E-06    6 .32743446844471 8E-02 
-7.22747/1929841  107E-06    6  •  1  979758741  75827E-02 
-6.45160777  3  021 927E-06   3 .05641 2099550624E-02 
-5.70906A629795342E-06    5 .894892171 735704E-02 
-5.000091 267843396E-06    5 .7048905  71 9658  51 £-02 
-4.  32  49*9  57  78  907  57  F.  -06    5.476865053780268E-02 
-3.683922571 R68313E-06    5.19991 70732 i 9558E-02 
-3  .077043609868248E-06    4 .869794646464365E-02 
-2.504968690771 787E-06    4.4440980551 29932E-02 
-1  .968061221 1 18917E-05    3 .92564571099527E-02 
-1  .4701 742447 10638E-06    3  .2726541 422 16548E-02 
-1  .007127876053239E-06    2  .6214871036441 77E-02 
-5.7932633960*81 6F-07     1 • 76851 4541 362738E-02 
-1  .871986448563937E-07    6 .51 33 13859402577E-03 
0      0 
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History  of  Thrust  Magnitude  (lbs.)  and 
Direction  (Raidans)  at  Each  Time  Point 


Missile  Heading  -45 
Target  Aspect    90 


o 


v{^';'-T    IS  ED  ANGLE    USED 

-1  •63353040*7009'  v. -05  k .68644838289931 6 

14399.99995182016  .387651 67770^2*49 

1 4399 • 99995S 16494  .3  83°  390  4 7 1 8042 6  8 

14399 .99995247651  .380185172898593  5 

1 4399.99995275883  .3771 757452566404 

1 4399-99995308508  .3712756293081 592 

14399.99995338534  .3581 180177472189 

14399.99995369842  .3462880488682431 

14399 .99995403657  .3348542026327179 

14399.99995441427  .3239179702043936 

1 43  99 .9999  54  8 49 88  .313  520 2020455658 

1 4399 .99995536674  .3036432 1 05026 ) 89 

14399.99995599447  j.29421 8646609093f 

14399. 9999567704S  ".28513571 1 122434$ 

14399.9990  5774172  .2762476770389699 

14399.9999  58  9666  5  .26  73  758108020489 

143  99.99  99  60  5172  5  .2  58309706  7560104 

14399.9999624809  1  .2488022056680618     . 

14399.99996496153  .2384328227279375      ' 

-3.360690567644473E-05  .2701896461683151 

-3 .05501 4234939948E-05         .2705728921977258 
-2 .761 88 1 66  58800 1 2E-05  .271 23 76903 1 2 36 1 5 

-2.43 13372  7 12 5371 2 E-0  5  .2721 725650935123 

-2.2 13 474462 30372 5E-0 5  .273384476456  72  51 

-1 .958432548230329E-05  .2746939275923527 

-1 .71 63961 951 93501 E-05  .276732674934504*2 

-1 .4875970412171 11 E-05       ".278943092186- 
-1 ♦272317324197033E-0S  .281 5787121561 

-1 .070895599476627E-05  .2847057554868285 

-8.837348332594896E-06  .2884056528652'06| 

-7  . 1 1 31 33978 1 872 1 6E-06  .29277? 7357020200 

-5.5419* 803 1254628E-06  .297949450815962* 

-4. 13072433062864SE-06         .304073678922899 
-2.887462000867227E-06  .3113490206533355 

-1  .8220.903209441  55E-06  .3200292054864544 

-9. 467271 32607903E-07  .3304437549857585 

-2.764530322  1 92844E-07  .3430223498022051 

0  .3500000000003638- 
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.4||i 
0*07 


History  and  Thrust  Magnitude  (lbs.)  and 
Direction  (Radians)  at  Each  Time  Point 


Missile  Heading  -45 
Target  Aspect   180 


o 


THRUST    USFTT  — WNGLtl    VSlu  

1 .367321 5820O5183E-05         4  .8371 7008429501  4 
14400  .00005733645         -1  .39741  5958209399E-G2 
14400 .00005555382         -1 .281 51 4725891007E-02 
1 4400  .00005378982         -1  .3854456351 OS004E-02 
14400  .0000  520097  6  -1  .90902]  6  6022  6  769E-02 

14400  .00005010682  -9  .036584067779^  \  7E-03 

1  /./iQO  .000048  1  275  7  .2ft  1  6  1  9234646867E-04 

14/JC0.O000460542  1  .0341  713638797«9E  -02 

14400 .000043869  44  1 .8788 A £ 443 51 437  9F-02 

1  4400  .00004155/!21  2  .59391  12885541  53E-02 

14400 .00003908793  3.1 655180971  12531  E-02 

1 4400 .0000364487  3 .574040945795? 67E-02    . 

3 .5041 698878861 31 E-05         7 .426648  621 3640 5E-02 
3- 21 54854670671 73E-05         8 .1 668059898296E-02 
2.92B26403^391217)T.-05         8  .757594 12 ;S58  <021  r  -OS 
2.642542579467247E-05         9  .2383 1 827751 8468E-02 
2.358333612686819E-05         9  .634692870081  22<  E-0S 
'   2.075631875359627E-05         9  .96288775879246  1  ii-0 
i    1  .79441881  51  65447F-05  •  1  023  1  6828785256 

1 .51 4665623229595E-05  .1044341 1376231 1 1 

1  -236335325271  1  *r-.E-c>5  .10594C0256<  v  6459 

9 • 593842 453 1321 46 E-06  -10  6  72222 95889411 

6  •  8  3  7  6  3  0  6  9  8  r<  8  9  4  3  2  E  -  0  6  . 1 0  6  5  • '  0  72  9  9  7  43  4  2 

4  .0  9  '-  3  7  70 524  57  1  3911-06  .105201  8906808 59 1 

1 .3629013 59636352E-06  .1021 2005581 5928 1 

0      '         9.999999999990905E-02 
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History  of  Thrust  Magnitude    (lbs.)    and 
Direction 


Missile  Heading  -45° 
Target  Aspect  0° 

THFC'ST    USET  AIGLET    USED      . 

-8  •  63 609 1 2 80 320598 E'-O C  5 • 4 9 7 04 57 V 1 0 1  OH 8 8 

1  4399-999992241  1  2  4  -874623557450994E-02' 

14399  -9999923 53 87  5-3201  (  f-  79 1  4 7490  3E-02 

1 ^399-99999246009  6 -0682243 1 4497995E-02 

1^399  .999992  63  66  g  6  •  58 3  993463 71  1 08E  -02 

14399-9999928314  7 -008778557880289E-02 

14399-9999930  5048  7 .454326872  3942  56E-02 

IZi399.pt  ■■■■■•■  ?  300'   1  7.    £97  /•  •  -'  2V  '  :•  3  483E-02 

14399-99999359178  8 -452702936649252E-02 

14399.99999393462  9.051 504926056 48E-02 

14399.99999434359  9 .77 1 095047974996E-02 

14399-99999483552  -1068473379757659 

\ 4399-99999542933  .1 19)950730603627    .._- 

-4-1 67844072779003E-06 8'W  5069  528621  1  8209E-Q2 

-3-4673123'33^3475£-C6  7-81043183  •':'  7  7696E-02 

-2.809366742004528E-06         7 -048833264681219E-02 
-2 . 1 95643663283228E-06         6  - 1850 1 4095925982E-02 
-1  -628276506234843E-06         5-240253851 83512E-02 
-1 -10631018930917E-06  4.1  I 5799875021087E-02 

-6-3 0 6 3.0 0 A f- 6 6 3 0 6 9 8 E - 0 7         2.712890 2 7  7 8 5 50 0 9E- 0 £ 
-2-0314460216375761-07         9-85041 445751 1216K-03 
0  0 
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Conclusions  and  Recommendations 

From  the  table,  the  general  pattern  is  that  the  conjugate  gradient 
trajectorj ..is  have  significantly  shorter  times  to  intercept  for  all  cases 
with  the  greatest  improvement  occurring  for  the  longer  duration  trajectories 
and  the  a\    ge  improvement  being  around  25%.   The  general  nature  of  the 
conjugate  gi   lent  trajectory  is  to  burn  at  full  throttle  for  as  long  as 
possible.   It  should  be  noted  here  that  these  results  represent  local 
minimums  of  the  cost  function  A)  and  not  global  minimums.   There  are  other 
local  minimums  which  may  be  significantly  better  than  the  ones  obtained. 
"Tuning"  of  the  computer  program  and  more  experimentation  with  our  cost 
function,  to  determine  its  "hills  and  valleys,"  as  a  function  of  thrust 
magnitude  and  direction  history  will  enable  us  to  achieve  these. 

The  purpose  of  the  initial  phase  of  this  project  has  been  accomplished 
in  establishing  the  desirability  of  considering  variable  thrust  engines  in 
conjunction  with  engine  gimbling  to  provide  trajectories  with  significantly 
improved  characteristics.   Specifically,  from  these  results  the  time  to 
intercept  has  been  improved,  but  improvement  in  other  characteristics  such 
as  fuel  used,  can  also  be  obtained.   Furthermore,  numerical  results  indicate 
that  an  engine  capable  only  of  restarting  in  flight  rather  than  a  continuously 
variable  one  achieves  these  improvements.   (1) 

It  is  noted  here  that  this  work  establishes  the  presence  of  improved 
trajectories  over  the  ones  presently  being  used.   Such  items  as  mechanization 
of  these  trajectories  into  an  actual  missile  have  not  been  considered. 


However,  this  type  of  control  may  not  provide  the  global  minimum 
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Suggestions 

The  following  extensions  of  this  work  are  suggested: 

a)  Tuning  of  the  computer  program  (problem  scaling) 

b)  Experimentation  with  additional  cases  and  with  the  weighting  factor 
UN  of  the  cost  to  determine  the  best  value  for  reducing  the  time 

to  intercept 

c)  Modifying  the  program  to  consider  minimizing  the  fuel  used  till 
intercept  or  other  trajectory  parameters  of  interest 

d)  Modifying  the  computer  program  to  include  three  dimensional 
trajectories. 


26 


Appendix  A 

Conjugate  Gradient  Program 
In  Finite  Dimensional  Space 
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p    I         -j   ■■    - ■-  FC  I  -  j  i  i.\]    i       (i     i  )  ,     (  I  .  1 1  ),.!.•(  POP  )  , » 
p.  5    D!  ■•»•  iSIOiNl     rO<  5)  »AT<  50  >*'j     <     '    ) 
P.r,    fcXTRRNAL    F U:\iCT. 

COMMOM/F  *AM/IFL*LF  *H*  MI*I>Y1  T*PV  3Tj  V  1  T(  >  i3T  i*U  «j  fO 
a.    DATAC  ^T<  I  >  *  1  =  1  *  3*  )/ 

R     pVT'Af  t?(  J  )  ,   i  -  1   ,  3H  )/  

*     •  ATA     V)*  K.c  1 *l    I   >  i   ['*  I  Fl  .  .    '  .    '  \  >  i   r  1   1  .  i       •■  '   .      I  TO*  r    '  i  '  1*1     \,     V  >l,v  / 


7  1  '     (.l.f.l.ir-      ..)/ 

r  h  .     =  .  n  n  o  1 

r o   10    r=i >(  j-8)*f 

]  0  i  \S=<  1  +  1  )/{ 

ii  r;3(  J .  )=Trc  i:j) 

l :  .'(■!-,).( 

IP  i  ■  OisiTI  N   r 

1  /i  ARG<  M)=TF 

IS    CaLL       F ".'  C  0  (  F       IC  ?»     *  A        ,  F  ,  (•?  ,  F 
If        •  ITK    CI  ,1  11)     F 
17     ]ij     ;..  OR  vjAT     (  l  x  *  1  P  Krt  I  j    CC  5 T     I 
17.1     DO    141  5     IX=1*.\ 
17.11     VR I T  F     C  1  *  1  4  1  A  3     ft R  G  <  I  X  ) 
17.  IP     1-4 14    FORMAT  <  IX*? 19.8) 
1  7  . 1  ■'     M'\  .<:    C  0\'TI   I  I 
F  ME 


'  j  !■.,-:     »  >,  !    '    I    !  y    I   r  :    }  -   r    ) 

: *  F 1 9 • P / / 1 X* 1 1 H M  I  vj    P TS    A  .  •  /  ) 


pf       S!         [  Ul  r  W»     FU'vCTC  \j,ARG*l'AL*GH4D-) 

P7     Pi     '•,■■]     I    i  Cr>*YO(S)*r     ! < 5 ) * YJ1 ( 5 ) * FY01 < 5* 5) * F001 C b*P ) * YU< 5* 8  *  50 > 

YJ1  r'(  5*Pj  50  > 

P7.5    POPPLE    PRECISION    ARG(.M') 

91  .r-    p.O'TEI  ;'     PRECISION    ('•-!(  v) 

P7  -7     r  OHPI  ,F     PPFO  I !    rOi\i 

P7  .7  -    DOUBLE    PflFC  J  SIO  'J    -■  ■    •  •      ,  \  r-  \  ,  .  {   .\  ■.,,  .  ■     ■- 

P7  .'      i  ■  ■    ■  i         •  RF.C  IS  10. v    Hh<  SO'  ) 

27*91     C!).'r(    j/PRI   1T/HH*A      >]    l>  IE?  • 

TO  C  :     GF.  Tl  J      '         !L0     Fl'J     :" "■   ;  ■''     t  AF  T'lAi'-'J;       )  '■    '  i  <■  I      G: 

71     COMMON    TAT*CAT*SAT*Mi\f*El  *fcP*CS*05C 

'JP    ::■■<     GM/FtfAM/     IFL*LF*R,    ii  >  PY1  T>  PY3T*  Yl  TO*  Y3T0  *  1    >> 

43    REAL    >\v 

,-7  .n  1     DA>JGAPF=P  .0 

/  .?  .OP    DO    101  0     I  =8  *  M-l  >  P 

/:  -5  . o  '-    ]  \t  .;n  ■  AG  =  1  A  R  '  C    ■■  <G  (  I  )  -HP  (  \  + 1  )  ) 

/  ;  .r  .•      ..(•:     IP]       '  -i"  .  i.      )  i  ■•  •'.  )     GO    TO    1010 

<    t  .0  5    DA  \IGAPS  =  1  A    i<:.- 

/ri  ,n*     i    HO    CO    T  I  JJUF 

/17  .ny    i;  j  j  Ab!  =0  .0 

.-"•'  .i    ■       •  ■    !  080    r  =  i.  *  M-P*P 

/7,C        '  :•!'  1  n  A  G=  D  AB  S  (  ARG  (  I  >  -  HP;  <  \i  + 1  )  ) 

at . i    if( rrn  >iag .lf  .dt'i  •-•''  )Gu    ro   in 

'•  .  1  ]         ■'  i  f ,-      -]  G 

A 7  .  1  p    1  n?o    COMTI   ^,- 

[EP<   »"TF    M,ARG( M) 
A />  I  \H'T=0 

AS    TPI=6«8R318D0 
f-6  ■•■'  vI  =  'Jl  +  l 

I «D1=0 
iR  IivPG  =  0 

t-<  CS=1  1  17  .77-40  .98*H 

i   ■  C  =  •  3  7  3  A  *  •  0  0  2  A3  *    EX  P  C  -  •  3  3  A  *H  ) 
c  1  DT=ARG(  vl)  /  -  I 

5P  J=P 

DO     1.0     1  =  1  »  l 
54  Y(I)=YOCI) 

10  ;;  o  v.  t  i 

57  C: 

58  C: 
;  -.'  C  :     BIG    LOOP    FOR     I  WEG  •     &    !   1  F  i-  •     IF     J    j  t  MJ 


ITAfi.c  »"Ai\dI  •■'=">  ■».•.;•■  "i  A*"  J  r 
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60 
61 

r ■-- 

<^3 
64 
r,5 

(*£-, 

*7 

i    ■ 

n 

7? 

7  3 

74 

75 

76 

77 

78 

7  9 

«0 

81 

■■? 
up 

R  6 
«7 

87  . 

ss' 

89 
50 
'1 
9? 
9?.  . 
93 
:>4 
35 
96 
97 
98 
c  (  . 

L 

l  i 
i  i 

1 

10 /J 
1  0  5 

1  V> 

1  T/ 

1  OR 
1-09 

i  m 

]  1 1 
i 1  p 
i  i  3 
1 14 

1  1  5 
1  1* 
1  1  7 
1  1  P 
1  1  9 
1  P0 
121 
122 
1P3 


1  5 

C: 
C: 

C:    ! 

i 


LO     15    1=1*5 

DO    15    J=l*2 

■x  L'C  I  ,  J*  1  )=0  .0 

CONTINUE 

IP     ( IFL.EQ.O) 


GO   ic    son 


520 


530 


t  p  (  a  :■-.  3 


53  5 


53  7 
53  « 

S  CALL 
10  540 
Y  (  I  )  =  Y 
540  CO 
/( 1 )=Y 
YC3)=Y 
5    CALL 


FYJJ  (  I 
5  50 


IMPLE    INTEGRATIO  1 

DO     1000    J=P*t*   ;! 
L=l j (0-1 5 

DO     52  0     1=1*5 

D0520    K=l*2 

YJ1UC I*K*L>=YUC I*K*L) 

CONTINUE 

DO    530    L=l*5 

YJ1 CL)=Y(L) 

CONTINUE 

IAT=P*C J-l  ) 

ITT=IAT-1 
(IAT) •GK.O-ODO)    GO    TO    535 

ATJ1  =A?.GC  JAT)+T.Pl 

GOTO    538 

IFCARGC  I  AT)  .LP  .TP t )     G 

ATJ1  =  ARGMAT>-TPI 

GOTO     53k 

ATU1  =A'?.GC  I 

.   :  ,11  =  ARGC  ! 

MTJ1=J-] 
FUCYv  1  *ATJ1  *T 
1  =  1  ,S 
J  ]  (  T  )  +F  H  1  C  T  )   - 
sJTI  \JUE 

(  1  )+LF*F  <1 C2>*1  T*DT/2 «0 
(3  >+LF*F K]  (4)*DT*D1 /2 «0 
GRADIENTC YJ1  *F*  1  *P  YJ1 *Ft 

DO    ^50     1=1*5 

DO    5  50    K=l*5 
,  K)=?  YJ1  C  I  *K)*D1 

CONTINUE 

DO    553    1=1*5 

DO    553    K=l*2 

FUJI  (  J.  *   1)=F  UJ  C  f  *  i.  )  ■  3 
'  i  ,       .;  • 


0    TO 


"i  ) 

f  > 

J1 


,)\  -  •    i]  l 


jj  i: 


i 


H  *  T  T  <J  1  ) 


r. 


L  OCT 


i-i  1 


jIPG.    PAH1IALS 


Su.  ^ 


^7  l 


DO    600    K=1*J 

1  F<  •",.  g£  .  J)     G01 
DO     560     I  si* 5 
5  6  0    L  =  1  *  ■■- 
YUC I*L* J) =0-0 

560     co.M!  )  iUR 

GO  TO 
570      l  K(  . .  ;  .(  -i- «  )  )  .  ■   i 
DO  5*0  1=1*5 
DO  580  L=l  *2. 
YUC I *L* C  J-i  ) )=FUJ1 C I*L) 
5B0      CONTI  WE 
DO  5*5  L=l*2 

YUC1*L*<  J-l  )  )=YU<  i*L*< J-]  )  ).+LF*F  UJ1  C2*L)*DT/2  .0 
YU(3*L*( J-i  > )=YU(3*L*  C J-l  ) )+LF*FUJl C4*L>*BT/2»0 
58  5  CONTI  WE 

GOTO  600 
590      DO  59  5  1=1*5 

DO  59  5  L=l *2  29 

YUC I*L*K)=YJ1 UC I*L*K) 


24  DO    595    I.J=1  >  5 

25  (      YIK  I*L*K)=YUCIjiIL#K)+FY'J1  (I*  IJ)*YJ1UC  IO*L*K3 

26  595  CONTINUE 

27  DO     597    L=l*2 

2  8     DO     597     1=1*5 

29  YU(  1  *L*K)=YU(  1  *L*K)+LF*FYJ1  ( 2  >  I  >*YJIU(  bL^.)*DTA;  ,q 

30  YU(3*L*K)=YU(3*L*K)+LF*FYJ1 ( A, I ) *YJ1 U( I  * L* K) *LT/2  »0 

31  597    CONTINUE 

32  600  CONTINUE 

33  1000  CONTI  NUE 

34  C:    SETTING    UP    TARGET    COORD. 

35  Y1T=Y1T0+DY1T*ARG(  N> 

36  Y3T=Y3T0  +  DY3T*ARG(  N> 

3  7  VAL=ARG(N)+UN*( (Yd ) -Yl T ) **2  +  ( Y< 3 ) -Y3T) **2 ) 
37.1     DISTAN=( Y( 1 ) -Yl T>**2+( Y( 3 ) -Y3T ) **2 

37  .2    DISPLAYED  I  STAM='SDI  STAN 
)  >  C  : 

30         C:  ' 

40         C:    COMPUTE    PARTIAL    OF    COST    tf«R«T«    IF 

/  1     QRAD(N)=1  .0+2  .i'l    !'  \J-C  C -v  (  1  )-y  1  7  )  -(  Y;\)  (  )  )  -I  ■.  lT)  +  <"  C  ■'■  -j  -    3'i  >*('Ffc!  (  ".  >  - 
C  1  )  > 

42  C:  FORKING  PARTIALS  OF  COSH  W.R.T-  U  ■ 

43  "  ~CTY1=2.0*UN*(YC 1 0-Y1T) 
m                               CTY3  =  2..0*UN*(Y(3>-Y3T> 

*c<  DO  ^20  K=l*  (  M-2)*2 

46  KX=(  '+  1  )/2 

/ 7  GRAD< K)=CTY1 *YU( 1 >  1 *KK)+CTY3*YU( 3* 1 *KK5 

4°  GRADCK+1 >=CTY1*YU( 1 *2 *KK)+CTY3*YU( 3*2 *KK) 

49  620  CONTINUE 

50  C: 

51  C: 

52  C:    PRINT    COsr,    G    VIOLATIONS*    BAD    TAT    VALUES 

53  WRITS     (1*777)     VAL* I NDG* I ND1 

54  77  7      FORMATC  IX*  4HVAL=  *  Fl  9  -8*  5X*  5HINDG=#  18 J  5X*  5HI  ND1  =  *  I«  ) 

55  C: 

56  C: 

57  C:    COKPOTEyFUEL    USED 

58  FS=0.0 

59  DO  630  I=l*(N-2)*2 

60  FS=FS+ARG( I)*DT 
6  1    630      CONTINUE 

62  WRITE  (1*888)  FS 

63  888      FORMATC IX* 10HF0EL  USED=  *  E' 1  9  .8  ) 
6/)    C: 

6^  C: 

f-6         C:     COMPUTE     THRUST    VIOLATIONS    AND    MAXIMUM    VALUES 

a  7    TTMAX=14400»0D0 

6  8    TTMIN=0«0D0 

*9    DO    680     I=l*(N-2)*2 

70     IFCARGC  I)  .GT.TTMIN)     GO    TO    660 

■1  1     rr  -li  \J=4RG(  I  ) 

72  INDT=INDT+1 

73  GO    TO    680 

7/'    6*0    IFtARGCI)  .LT.TTMAX)    GO    TO    680 

7  5    TTMAX=ARG( I > 
7  6    I  \JDT=I  NiET+1 
77    6«0    COslTINUF 

7*    C:    PRINT    NUMBER    OF    THRUST    VIOLATIONS    AND    MAX*MIN    VALUES 

79    WRITE     (1*9999)     INDT*TTMAX* TTMIN 

«0    9999    FORMATC IX* 28H NUMBER    OF    THRUST    V IOLATI OMS =  * IF *  /*  1 X* 
6HTTMAX=*F 1 9.K*/* 1 X  * 6HTTKI N=* F 1 9 .8 ) 

82.4    1212    CONTINUE 

83    9999,    FORMAT    C1X*4HVAL=*F19,.8*3X//1X*  10HYUC  1*1*  1  )  =  * 
3F19.8/1X*2.F19«8/1X*10HYUC  1*2*1  )=*'3F19-8/lX*2F19.8/lX*10RYUC  I*l*g)=* 
3F 19.8/1X*2F19.8)  30 


\  ■  h  P3P3    F  OH  MAT     C  1 X*  1  O'rnfUC  I  *  1  »  3  )  =  *  M-  1  >    . «  / 1  v  ,  -  t-  l   ,  .  -  /  l  - . ,  i  ■  i  .  ;  ,.  c  f  ,y  ,  <  )  =  , 
3F19.R/1  >\*PF  19.R/1  y.j  10HYUC  I*2*a)=*3H9«^/iy.*'.;r  1  ^.f<//lX»l  lhG  /) 

185  ;r,  IT|,  c  ]  tkL\l\h  )     CTY1*CTY3*  f  Y(  J.  >*  1  =  1  ^  lO  *  V  1      .     ,JT 

]u{.  ///i/.    FORMAT*  1  X*  5HCTY]  =  .»  K  1  9  .8*  5    *:  ^.M    i."/]a,m      (  f  )  -  :, 

3F1  9  .^/IXjPF  19  •  P/1  Xj/iHY  IT  =.»F  1    '  •  '    -•  •■     t  AT  .!''".*•) 

1  F'7  hOfp    E  F  TUB  M 
1««  EMD 

PP  ]  c;("B7-.OUTI  M     FU(  Y*AT*TT*MT#  I  'J)  1  *  T  JJ'ii  »  L*  ) 

ppp  DIMFMSIOtf    Y(  5)  »8<  b)*DYC  b) 

PP3  COMivll    •,,     TATjCATj  S'V'j  -  -j»  '•  1  ,  "  P  ,\)>  »>    '  O 

Pp.i  PAT.'      CP(  f  )  >  r  -]  >  t  )/0  »f  .»  3  •  I  ''■)■      •-     •!•  ';•    -O,"'^;-'      -?      1'/ 

os  RFAL    vSrt 

2  /  PI  =3.1  /j  1  59 

pp«  ,  MS=Y(  2  >*  *P    +  Y<  /i  ) 

'.'=*      -T(  \}b  S) 

P30  OS=OSC*V,v,S 

p3l  oj=u    /CS 

P3P  XAU=ATA  >J2<  Y<  4>.»Y(2)  ) 

■v.  ^3  I F  <  TA  U  •  0  F  •  0  .  0  )    GO    TO    P  1  1  0 

34  TAU=TA  U+2  -0*PI 
P?5        110    CO  vil  I  'li'r. 

p^r-  T:'.  •■-  i  A i '-AT 

P37  AB=ABS<TAT) 

P3P  T  h  (  -s  :  .-'1  .p  I  )     GOTO    3 

p  -;  ■  i  A  LP  =  A  - 

•    i    i1 0  T  i      5 
o«l     3    ALF    =    P.f      •;     "■  I     -     ■■ 

.    v-0    '■     r  ■■- )  > 
p  /■  :•     !     (  f<  '.  •  i  '  •     (  ;  )  )      ;  ;  '       !  '  > 
.  i     ■ 
'     TO     IP 
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•AR  F  1  =SI   v><  A1   ) 

i  E'P=-C0S(AT5 

2S<  GOTO   PO 

P51  15    :-  1  a-SI  M(AT) 

PS^  F'-J=COS<AT) 

P53 

•'''■,  A 
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P'-P    F  ^J=C  M*QS 

?     FA  =...A  ieC 
P6^i    IFCFN/YC5)  .LF.l  35.^  .0)     f-101 
P65     I  JDO  =  I     T  0+ 1 

i> 3    CAT=COS(AT) 
p*7    SAT=Sli\I<AT) 
r'^R    DYC  1  )=YCP  ) 

c-h  ■,    PYCP)  =  C  <  TT-FA  )  *CA  1  -  c  v<0  1  )  /     C  s  ) 
P7   i     DY<3>=Y<4) 

271     DYCA)  =  (  CTT-FA>*SAT-F    i*I-2)/rC5) 
p  /;.     j  Tc  5,)  =  -TT/P050«0 
P  7  r-    P  F.  i  i " 
•J/7     K'MD 
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■ 

!■     (  •■•'   .      .GE  .    0  .0     .A  «JE 
•      CVAl      »LF  •     -HI      .0."  . 
I  A 1     CAT 
PA 'I  i 

f.  I 
S    ALPTAlJs]  .0 
]    -1  =-CA1 
PAT=-SAT 

:,i  |  .■-.  -j  =-ALl    I    ■ 

I    ■  =QSC  *2  .0  ■(-  :  (  /    ) 

■  ;    CYC  P.  )**3       +■{(.  A)#*g ) 
:pF.-T(^/S3 

I      -•=  1  (?)/■.'■ 

=  YC  A)  /V  ■ 

LPYP=-AL  f<      ) / 

ALPTAfJ*Y(P.  )/tf.'-i 

i  •  '   =i    [A    I/O  ; 


TAT      .JLK.     PI )     GO rO 
fAT     .bQ.    8  -0*PI  )     00    U     -  L 


■  I   JG    DE  ^UATIVriS     Oi«     UY      -  .     •  ?•        I'A'l't' 

■  •  -  (  i  •'■  'i  ) 

■  '  v     '  i      (      '  .C-'T  «PI  )    GO     i        ' 

,  i 

•  1  ■  i      /i  ,'i 

s  p  i     /  •      ■  •  -  -•  .o*pi  -a; 

?P  1     i  '•      \Ct  •   >2  -  3*C0S  C  P.  .'71  ■'  l«Ai  P  ) 

-5c;     C^    -0«5565  +  CCA*A(v  I  Ml  CO  .*5+i    .  1  :\*-/i<\,  1   .  l     7-     -      '■'•',      ) 
P:  --C  1  .n-P?  .^1  v9*ALP*(  1  .0  +  5  .9P8?-'*ALP*C  1  »0-  •66b^*Al  F*C  1  .0-  • 

3  3)3*5.        •       i  r-  -  p 

3RA    C'<J         '  <-I  .01  C  .?!i  +  0  .  55*.    .j,  i  .f  ;•  -u- 1  i  .1   y/'f       j) 

=r-P.TR7031*SI  \'C      .  -  7  j    i  )  11  (O.e-5  +  O.I        i« ■  -i»  \  •  1      .  -  ■  . 

'■'P*      I?     (  -  i\-.LF.  .  1  .5  55)     0  0    TO    ^'1- 
*P7  ■        -  .  1  70*Ci     • 

32R    f;:i    YO    /;7 
329    /|5    CA™V=.l   ■  KCCA 

'■'/  i   :.---•    .  7  J—        (  -         .f    i         -        .-...'       ,  ALr  +  v'  •]   .776  i  ^*Aj_l 

pot?  .93;    <3fi^  ALP*ALP*ALP  ) 

331  C;MALP*CCNALP*AMI  J]  C  .3+»55*f   J*  1  .095-0  -074*Mi>J) 

332  T  h  C  ■'■'.  J.L*  .  1  .o'/k  )     GO     I'O    41? 

333  C  J     ■  "--  '  .07i *CC  J 
?3A    GO     :  :      A 9 

•  J !      /    '      "j      i=  i  5  5    ->:CC  s] 

'-'  ■-'■     /    1    i  .•  '.  (  p  ,P)  =C  C  -CCAALP^C'l'l  +c  •]  "■   1  )     '.        l!-(«  1 
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3  ■•  ■  ■■ ,  /1)  --  S-CCA    c     r+c  J    '  1  ):'         ■")/-,  <     1 

C  /-,P)  =  C  C-CCAAL?*:       C+C  i    :  ■  :    )    '  <■■■■-<    '.C  i     M'SAT  +  C  M  ■.  vi*  i  - 

)*jvt\i  t'P  )*Qc -CCA*SAT+C  >I*t:P  )  *0,S/p  3/YC  5) 

3^0     1  ?  rC/uA)=C  C-CCAALi      '      '  +C    .    LF*Eg>*ALPY4-(CAKi«i*SAT  +  C^MM»»  E; 
)*      lYzo  *QS-CCA*SAT+C  0*E-P  3  *=QS  •' ■'  >/Y(  5) 
3A1'   I  FY(  /  ,  lO  =-PY(  'J3/YC5) 

\  a  rj 
•3/, -j 

'/"  ;  E  :'C  1  ,  1  3=0*0 

345  rFYC 1 ^2)=l .0 

346  DF  r"C  ]  ,  3  3--0  .0 
7  FEYC 1*A)=0*0 

?/'"    PFYC  !  >  5)  =1    .0 
3A9    l    •     (   \,  1  3=0.0 

i-if',?  )=0  .0 

7'M.     !(•  £  (3i  1  3=0.0 
"'-?    DF>'C3*     3=0.0 
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V  ) 

DF  Y(  3j>  3  )='"  »0 

;,.;(.,/)  n  i  .  o 
I  F YC  3* ? )=0«  i 
DF  f</!>  ]  >=0  .0 
■  C  4 j  3 ) =0  •  ( ' 
It  Y(  5*  1  )=0  .0 
!  FYf 5*P)=0«0 
r -  y  c  -. ,  "■  >  =  r  .  ■ 

!  F  jr<5*4)=0«0 

•  ■!-   .(    „  -•)  =0  .0 

!  F\  CP,'r')=(  -CCAAI  +C 

*GS/Y< 5) 

DF I  T(  /i  >  !    )  =  <  -  C  C   i  A  J 

5  i  FU< P>jP)=DF?.K£j 

6  DFU<  ^*':'  )=DFU<  4* 

PFiK  1  ,  \  )=0 

DFU( 3 >> )=0 

DF EJ(  3*  1  )=0 

'  ■• ;  ■  C  L  • ,  f  )  ■-:  n 

dfO   (^ 
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"  ■  :  .  (       ,  i    )  - 
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EMD 

SO-ROUTI  \iF 
PI  y.h  ■<!?  10       X<    : 
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in   ■  F  >:c-  T  CM    G(  .\J) 
DI  -••••:■    ;S1  ON     H(   -0) 
i     .UPLF     ! 

#r-ALFSj  t*  '>k»  r-  > »"; 

1        0  ■  <-l    vI/PPl   JT/hH 

CALL     F  :j''vCT<   J> 
t  ?     r  vi      =  j  Fp, 

KOU  Jl  =0 
l  ..  .-so 

>:  i  =   +i 

1      ]  if]     /y<     11  =  1,    ii 
-     <\  =     OU  MT 
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3     I  F  (  T  1  -  )  )  4  *  ■ ' 
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'  ■  CALI      FOC  'f  \|jy*K*G) 


■ 

/  /  c 
/  /.if- 
/'/  7 

.'i  /a 

/i,'.'  ■ 
/j50 

/"-  1 

A  5 

/  ■   '    , 
/'  '       " 
/'  ^  f 

-'  '  7 

/!  5  -' 

/.'  c  < 
/,*] 

4  £  0 

t  e  ■'-  .  p. 

'■63 


r  o   !  '•   1  =  1,  -,j 

1  ''        i    DY+GC  I  >*H(  T  ) 

J  r  c  r  \  )  1  7  ^  -  ■  ■• ,   •  I  ' 
"•    '      T  "  (I-  Y-F  \)  1  ff*P0.»pn 
]  •■•    AyBPA=A^aEA  +  Al  FA 

AL.F-'  --AMBD.A 

IFC  hMj    •  *AttF?D.A-l  .[:!n)|^i.Mo 

H  r1  Tijr  \] 

■::  ■    'I  ~n  . 

'-i    rFfp.-'j  .■■••)■■   ,,-,-.. 

■  •  '   r  *  (  r   •>:     _  )  /A    :83  A  +  ]   -'    i-fi, 

•'   '   -  !  f  '      >  *  '  A:       (         ),  ]  ABSCI   t  )  ) 

DALFA-.  /At  f,c, 

CALFtf  =DA]    •■"  -;-7    ,..h   >-p.r/a.    •  £  i=    •.  /    ,  r 
TF(  DAL  FA  >P3*P7,P7 


)' 


l     ,  -i 


-  =  .M  + , 
?A    X( J)=H(J) 
I -p|  AY     "Ci  j  r=",OL)>  ," 
CALL    FUNIC  ;  (   i*"*F*Q) 


4*3    .1    1  IFT?R=J    FT 


/  -  ; 
h£f 

4*7 

/■  c;  •-■ 
/:  r  C! 

^  7 ' 

/•  7  n 

47  1 


P  u-    IF<  IE?.)  47*  P**  47 
p  r'      I  FR  =  -  1 

GOTO     1 
P7    W=ALFA  Hcn-v'  -TC3  'AL  FA  ) 

A  J  h  a  =  C  LT  +y-7  )*AKBI  A./f  DY+P  .  E 

I  i :    ? R     1  =  1,  si 
?.►:    X<  I  >=X(  I  )  +  CT-ALFA.)*n(  I  ) 
TSI  i  AY    "OLD*  ="  *  Oi  !":-"*"  W>  y?  •■  =  /!" 

CALL    FUMCT(  \jj  v  *F"*G) 


■*W-DX  ) 


^-'7  1.1'      i 


'  VP 
^  73 
47  4 
475 
47fi 
4  7  / 


4«0 

/lO  ,.- 

■'J8  3 
4  p!  ^ 


IF<  F-FX  >29*P9ji  .30 

P  9    I F  (  F '  -  F  Y  )  3  K  *  -;  - ,  ,  7  ( ) 
30    PALFA=0 »D0 

DO    31     1  =  1  jl\| 
3  1     DALFA  =  D^i..FA  +  G(  I  )  "7(  I  ) 

EF<  i.A-.r    ■  ).7-  ,.;  -,,:-.' 
■      !F(,"'-     I):,:,       , 

'     (IT -DALFA >34*3^*  ?4 

3  /'      F>  -;■ 

DX=DALFA 

T=ALFA 

AiME  I  A=ALFA 

GO    TO     ^1 

IF  CFY-i    )  7  /  >  -■)■'-  ,  ■•■/ 

im-CI   ':—  u.,F.n   ,  ,-',     ,    ,3.7 


34 


1  '    7 

'/ 

■  \    F 

/:  •  \\ 

DY=CALFA 

I    '     ■ 

o  v..  i  ",-;•  f.    :]  g-a.LF '■ 
i       i-     an 

'■  M 

3F< 

T=o.r n 

A  9<= 

DO    39    .J=>  *   J 

• 

..'+.■; 

• 

••  (    )  -  •  c ,  i  >  -  :  c    ) 

•  - 

39 

T  -']■+)  'A  BS  <■'•(.)) 

/.!•    5 , 

•  '     1 

1  I 

73  5     1  =  1  ,p.*>l 

■  ■ "  -  , 

.02 

ri- 

(  I  )  =  H(  I  ) 

495. 

.03 

735    COM  T  MUf 

496 

II'  (  KOU  VI  -;\Jl  >4]  ^40>^0 

497 

40 

j  )■('.'-!•  !   <   )-'.''5j  45  j  /'I 

■  r  ■ 

.'i  i 

■I  (CI  DF-F+EPS)  19*85*42 

b  9  > 

OLI'GsGXfO 

-     ( 

1  F  (      H    JT-LI  '■:  I'!  )/  3*4/J*  / ''' 

Ffll 

/i "; 

I  } . 

P  = n 

-^ 

• 

nc    Tl     ! 

>-    >'■ 

l  < 

]    >■,.   :-   1 

'  04 

ifch  j '."-'■■  ■  •  >4*  j  e-f>>ia 

r  p  > 

I  ■■ 

:■■(:;     ■  ■  -;■       )*-.,  ■','>-, 

/,r. 

1  n    = 

:   -■•»•/ 

■'  i 

i    |  [  1  r  <  . 

P 

E   i 
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Appendix  B 
Conjugate  Gradient  Program 
In  Infinite  Dimensional  Space 
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1  C:  THIS  PR0G4A>  DOES  CO»J.  GEA1"  .  F  Or   ISSLf  "I 
p 

3 
4 

5  PI  tvE  <JS  I  ON  TT<81>,AT<81>,E1(81>,E2(81),8(:),Y(5>,  L2  M<  6  >  *  T  A I  <  8  1  )  , 
Y2<  81  )  ,  Y4(  8  1  )  ,  CA(  8  1  )  ,  C  K  8  1  )  ,  C.A  T(  «  1  )  ,  SAT(  8  1  )  ,  Y 5(  8  1  >  , r  (  )  ;  r  A  (  u  \  >  , 
PLAEv(  5 )  ,  DV  (  5)  ,HAT(  8  1  )  ,  KT<  8 1  )  * S  1  (  8  1  >  ,  SP.  (  8  1  )  ,  TT  1  (  *  3  )  *  £  11  (  8  1  )  ,  Y 1  2  (  &  1  ) 

6  DI  ME  tfS  ION  Yl  4(  8  1  )  »  Y I  C  5  >  ,  YO  C  5  )  ,  'u''-'  <  <  -'  1  )  >  •  1  3  C  <■  1  )  ,  r  »  ,  (  ■■  1  )  ;  i :  (  •  )  , 
CAK81  >,CAT1  (81  >,SAT1  (81  ),  Yl  5(8]  >,DY1 <  »  .•  '  i  (3  )j'r  '140  :  >,ATL(81  )  , 
TTL(*1  ),EL1  (81  ),ELP(8]  >,TATI  (83  )  ,  YL?  (  8  3  )  ,   'L/i(  •' 1  )  ,0  iL<  •    ■  ) 

7  DIME  J.SIO  v    C.ML(81  ),CATL(81  >,SATL.(  c-  1  )  ^  :  i.:-  (  -   3  )  , 'r  i      (  M  )  ,     I  .  ■( 
e    DATA     ITMAX,  TTG  •  AX,   ■        —  / 

rATA    ^C0,:\'C1,    CP,>\3C3,^C4,    €  8,^0  6,    cv»    i>-  *  i"iC9  *  .MCI  0*  -\iC  1  1  /  .23n6v8*  1 
3.P.48'  1  97, Pr<.6 09739,-20  «9 55      79,4.1362  '-■'  ,  -  »3     P.743I  .';,  .50  764409, 
-•12286171,  1  .35768-i'>,-r  -I  7N.*V'Y"  ■      ;-.  ra93/ 

10    DATA    (TT( I ),!=!, 81  ?/ 


1  1     DA  f  ">     (AT(  I  ),  1  =  1  ,  W')/ 


11.5    DATA    (  A  T  (!>,!=  i  5  >P5)/i 


3  •'  pi    P"     (  YPC  J  ),      C-J  ,  lO  /' 

13  DP  7  *      r  ,TF,;      •     !  '    ■  '  •  .• :  '  / 

3  4  DATA     (3( I ),I=l ,5)/0 -0,3 •  >  -  3  •  !  >     >      »'  8."  ?  >'*  ,  -6  .P.  8  3  1  8  / 

1  5  DATA    CCO,  CO  1  ,CC2,C03  ,  UC*, CC  b  > ( :..: 6, OC  '.'  -        -  » >  :0  -  ,  CC  1  0,  i:  0  1  1  /  .  3'  3  b  7/  i : 
2 • 5373  7 1 , - 1 1 •  9  8/  872  ,  1  1  .098  A  1  1  ,  -3  •  78 b'    ' ■  • '  ■  -•  >  •  ■'  :   !   '  -•  •  7  •  •  7  . , 

•  3 533888 6, -.2 5822P 95,  .071  1761  5v:>-  .'O  -90^  16,  .0017203*6  5/ 

16  PI =3- 141 59 

17  2     ITG=1 

18  I^Dl=f 

19  IMDG=0 
PO  ITL=0 
^1 

^P 

>3  C:     CC--    i'i      INITIAL    G        i   i>    IT     rHA.Jh.0'     i 

P^  DO     ''     1  =  1  ,L^ 

?5  YCI)=  i'0(  I  ) 

26  L\    00. j'f  j  mUE 

C7  CS  =  1  11.7  .77-40  .9^*H 

PR  QSC=  .1734*  .00P43*E>'rj(  -  .3:  ■  /  •  "> 

.    i  i      =    ;•  /f  '  .r 

30  3  .  ■   !  ,  ■   i 

31  i     r      ' ) - Y  (  2  ) 
3P  Y4(-''T)=Y(A) 

32  .5     ;.  ■  _  .  ( ■■  )       ■    ..   +':  (  .•  )   ■*&  .0 

33  VM=SQfiTCVi*iS) 

3^  QS=QSC*V- ? 

?L  >'M=V;-'/CS 

36  TAU=ATA    fP  (     (/-O,     c  ''   )  *> 

37  TAT((ST)=TAn-A1  (         ) 
?  =A.S     (1     ; '(  •  7  )  ) 

39  IF(AB.GT.PI)    GOTO    3 

^0  ALP=AB 

4]  GOTO    8 

fjP  3    ALP    =    2.0     '-'       I'  -    AQ  37 

/  5    DO  1  =  1,5 

'■ "  ■  •  c  ;■  .  (    i )  .Ef>.    c  i ) )    go  ro    i 


/:•' 


50 
51 

5P 
53 
54 
55 

£6 
57 

5'": 
5 

60 
61 
6! 


66 
67 
68 

69 

7'i 

71 

73 

73 

74 

75 

76 

77 

?'F 

7' 

«0 

81 

88 

83 

84 

85 

86 

87 

.«  p. 

^9 

90 

91 

92 

93 

94 

95 

97 

9H 


C   '   I     I     U 

1       i;  ir  i  =:     :j  i  - 

i  •■  c ';'..  r c  ■'!)•  i    o - r ■  i' )         ■  ■) 

(  ;  '     ;C        ''    i 

F?  (.»  T  )  =  -C  05"  C  AT(  77)  )  .       ■ 

GO  rO    ;•■  i 

15    El  (  m  )  =-S  I  0(  AT<  MT )  ) 
F.2<MT>=C0S<AT(MT)  ) 


C:     FORMING    CA    AND    CN    FUNCTIONS 
20    ALPS  =ALP* ALP. 
ALP3=ALPP  HA.LP 
ALP4=ALP3  i-AL 
AL  '■■       J.    <-'  . 
i'  }',< 

':-.         3 

CI  =CCO+CC  1  *ALP+C  '  .*  ■  LP;  +C 

C?=CC6+CC7*  MN+CC  8 *MN2+C C 9  *M 

CACMT>=C1*C2 

N1  =  C0+  ;C  H  ALP+NC2*ALP2+NC3*ALP3+NC4*ALP4+NCS*ALF  5 

N2=NC6+  JC7*7  \B-NC8*MN2  +  NC9*M  M3  +  \-C  10*M  >J4  +  OC  1  1  *i     )5 
CNO'T)-Nl*N2 

■  F  v'=C:\i(>,T)*QS 
FA=CA< Ml  >*QS 

I  F(  :•     /'i  (  5)  .LE  .  3  3  53  .0  )     GOTO    H? 
IivDG  =  'Ii"7E'0+l 


AI  V  3+CG  -i  :•  i  P4+CC5*ALP5 
J3+CC10*rfN4+CCl  l*i  a-5 


)=C0S(  AT('-M)  ) 


(7  /I  (i  1  )-FN*E  1  (Ml  )  >/*(  5) 


-FA)*SAT<  7.  )-P  NJ*E2(f<  1  )  >/Y<  S) 


93    CATOv 
SA1  C        >=?I  jC/S 
\  5<        ')-13  (    :> 
}    r(    i       •-:>  C  fr  ■') 

j  '•  ■*  (  !     .'     ■  (   (    ; .   < 

F2<£V5T>=DY<2) 

DYC3>=Y(4) 

J  f(4)  =  <  C  T1  C  -i  l 

F4((-  j  )=DYC4) 

DY  C  5 ) - - TT ( MT ) /80 50  . 0 

I F     C     .  .:>  0.81  )    GOTO    30 

C:    SIMPLE    INTEGRATION 

Y( 1  )=Y(  1  >  +  (DY( 1 )+DY<2)*DT/& .0)*IT 

YC2)=YC2)+DYC2)*DT 

Y  C  3  )  =1  C  3  >  +  (  D  i  (  3  )  +  D  Y  C  4  )  *  1 5T  / Q  •  0  >  *  J.  T 

Y(4)=Y<4)+DYC4)*DT 

YC  5)=Y< 5>+DY< 5>*DT 

30    GO  ,7  1  WE 


C:     SETTING    TARGET    COORD 
YH=Y1  T0  +  DY1  T*TF 
7  J  f =     r  C+DY31#TF 


1  GO  C  :     COST     E  XP-  ESS  [ON 

10*1  CT  =  TF+UN*(  (  -'(  I  >-YlT)*«2»0  +  <YC3)-Y3T5**2»6) 

!  02 

103 

1.0  4  C:     SET    Y    AND    DY    VALUES    FO-1    CT'U     C-UMPUl'AT J  0 -J 

105       1 F=    ( 1 ) 

in.-.  Y3F=Y<3) 

1  r  v  DY1  F=1:YC  1  ) 

h-j!  !    r:sF=')    (  :    ) 

■■■■■■,.-  n    .  i    .  ,  "     oi'     i  )     :  ■:         i   ■  7  :■        !      •     l 

]  1  0  32    WRITE    C  1  »  501  )     ITG>  I   JDl  >  I   M.)G  »  •  '  L^O'i 
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J 

•  •    »  T  » 

TATiv 

)     .LE  . 

r  I  )      Q( 

i.  'J     <  5 

.  PO  .    f 

1  .0*PI ) 

0  0  :  0 

Ml     501     F0RMAT<4HITG  =  *I8*5HILMD1=*I8*5!         fJu  =  ,£i    ,//,     ■         .  ->  I R  ,-  ••  ic  OS  :  -  >  -  '      a 

1  i  ■• 

I  13 

114    C l FORMING    LAMBDA* HT*HAT>CTTF 

115;    C:     DERI- NATIVE     Oh     COST    '■.'•R.T.     FltiAL    TI 

ii         .'    F=     |  .0    +    ?.0    #tJ  N*(  C  f)  F  -  '!  T)     *    (DY1F-DY1T)    +    <  Y3F-Y3T>*C  LY3F- 

DY  3  T  >  > 

1  1  7 

1  IP 

119    C:     SETTING    FINAL    VALUES    OK    LAMBDA 

lpn    i,       (  1  )=  .P  .0    *[Jtf*    CY1F-Y1T) 

1^1     LAM<2>=0»0 

1  9!      LAM<3>=2  .0*UN*CY3F-     -  D 

1      •     LA* (4) =0.0 

]  LAK<5>»0«0 

1P5 

1  rJ  6 

1P7    C:     LOOP    F0':     GETTING    GRAL'IENI     ftNl 

1   i8    DT=TF/80-0 

i     >  do  fir   ;»:t=81  *  1 

i  30    C  !     !;iV"  •     -0:      Ob  TTIWI  i     I  NATIVES    I 

131  IF    CTATCKT)     «GF.    0.0     .AND.    TA1CMT) 

132  IF    CTAT(frT)     >LE«    -PI     .OR-    TAT*'>.T)     -EO.    P.  .0*PI)     GOTO    35 

133  E1AT=CATCMT) 
13  /j    EPAT  =  SAT(  <T) 
i  ■•  -        "   i ■■■>  r=-i  .o 
136    GOTO    ^0 
]  -,  7     -i  s    ftL     i  AU=  1  «  0 
]  ^      -  1  AT=-CAT(MT) 
]  39    EP.AT=-SATCMT) 
140    40    ALPAT=-ALPTAU 
]  ii\     Qs  fpsFSC*P  .0*Y2Ci-lT) 
i 42    QSY4=QSC*2 »0*Y4(MT) 

■143    VMS=«CY2CMT>**2  •0  +  Y4<MT)**2  .0) 
1  ■'  !    -.  ■  =SQRT<  v/'XS) 

145  QS=QSC*W  S 

146  CTAU=Y2(MT) /VM 

147  STAU=YACKT)/VM 

1/j)     AL3Y2  =  -?J   "T  vu  c  i  ^  t*G  ■•-.  I  :<5  /.(,,  )    /    (  ,  ■-  (     .)  -a  ,  £  c  ■  /i  )  ) 
i  fl9    ALPY4=ALPTAU*CTAU**2/<i  8  (  ■■  I  ) 
1  50     ■         >=C  I'£  O/CS 
151     MNY4  =    STAU/CS 
1 

1.5/i  ■; :     FOF  ■•  '    !G     •  '■••>.  v-'Vn.  v  ■"         i       i!  •  •.•'!•  1 

1£«  f-I>PP.°(  (  ■  '. ■)  :• 

1  bf  IF     (A:    .I.-T.P  I        ■  i  '    Ti 

1 57  ALP=AB 

158  0  0     'I"     ixt. 
1 hc  43    '  -    -2.0*PI-AB 

1 60  44    ALP2=AL:  *Ai 

161  ALP3=A]      "       LP 
j  C--    AL  »4=AL  '  >*ALP 

.      f;       .    "s       i 

If  1  ■         :    '      ; 

i    -  ■  T    .    j   i 

167  WN5=MN4*MN 

1  6R  ClALP=CCl+2  .0*CC2*ALP+3  .0*003 *ALP2+4  •  0*pC<*  *ALPS  +5-0*CC5*ALP4 

16Ci  C2MN=CC7+2»0*CC8*MN+3  •0*CC9*MN2  +  4.0*CC10*:-iN3  +  5.0*CCl  !     i 

1  70  I\)1ALP=  >JC  1  +2  .0*NC2*ALP+3  -0*NC3*ALP2+4  •0*NCA*ALP3  +  5«0*NC5*ALP/ 

171  MP  lN=NC7+2«0*NC8*MN+3  •0*N»C9*MN2  +  4«0*NC10*>   I3  +  !  •0*MC1  1  • 

172  C1=CC0+CC1*ALP+CC2*AL        hCC3*AL?3+i  ALP4+CC5+ 

173  C2=CCiR+CC7*MM+CC8*M.Ni2+CC^*>   »3+CC10*i<    ;4+CCll*MN5 
!  7  ti  N1=NC0+NC  1  *ALP+  \JC2*AL?2  +  NC3*ALP3  +  NC4*ALP4+NC5*AL!  39 
1  7  5  N2  =  MC  6  +  MC7*MN+  MC  R  *K  'JO  +  X  9  *r-  .-J3  +  vCl  0  *  ■:■  lJ4  +  flC  1  1  *MN5 


17*    CAALP=C8*C1ALP 
1  77    CA>H=C1  frC?   i -Nj 
3  /'•     CtfALP=N2*  Ml  ALP 
179    CNMU=NJ  *'M2M  ! 

I  BO    F8Y?=C  <-(CAALP*CAT<MT)+C?JALP*£  1  CMT>  >  *ALPY2-<CAI«    1*CAT 
)*MNYS>*tlS-(CACMT)*CATCMT>+Ci>Jt  4T)*FJ  C    if)  )*QS  f2)/Y5CKT) 

If  1     FP*4«<  C-CCA*I     *CM  (t  1  )+C.j^  L  F  i  ;•  1  (  i -.1  )  )  ■  ALPY^-CCAtf M*CAT 
)*MNY4)*QS-CCA(MT>*CAT<MT>+C  S3CM1  >*E1  <MT)  >*GSY4)/Y50  T) 

II  F2Y5=-F2<MT)/Y5(MT,> 

183  F4Y2=<  C-<CAALP*SATCMT>+C!\IALP*E2(Ik  1  )  >*ALP*2-<CA  .   )>  "  Al 
>*  ■  MY2)*QS-CCA<MT)*SAT(MT)+CW(MT)*B.2(M'i  >  >*'QS  i  £  >/  i  '  CK1  ) 

184  F4Y4=C(-<CAAL?*SAT<KT>+C:\fALP*E2(i4T)>*ALPY4-<CAi'  <J*S     ' 
)    i-  tfY4)*Q$-<CA<MT>*SAT<MT>+CMKT)*E8(MT>)*GiSY4)/^  5(  -.V) 


(   .T 
( t*  T 

( K  T 

( r»]  r 


)+CNKN*E 
>+CNIMtf*1E 

)+C  j  .  ;*E 


ICMT) 

1  (  Ml ) 

£  <     1  ) 

£(  ■  'i  ■> 


1  P  !:■ 

186 

187 

18K 

]  8  9 

190 

191 

192 

193 

19/1 

lc<5 
1  9* 
1  07 

1 9 q; 


}•/  ••  b=-F^  CI-'    )/v 


1  ) 


C:     FORMING    D.E.    FOR    LAMBDA 

DLAM< 1 )=0.0 

DLAMC2 ) =LAM< 1 ) +LAM ( 2 ) *F2Y2+LAiY ( h )*F4Y2 

DLAMC3)=0»0 

D  ,AMC  4)=L £    ( P ) *F2Y4+LAM < 3 >  +LAt< ( 4 ) *F4Y4 


Ji  -:,  (  r,)=    LAM<  2)    *    F 


Y5    +    LA.^C-4)    *    F4YI 


C  :  DERI  VAT  I  VES 
FPT=3 »0/Y5< MT) 
F4T=1  -n/Y5C  -IT) 

f  5  r=-3  «o/f  r  50  .0 


UF 


iY    W  •  .-  »T  •    TKl  1  A 


:•'-  T=  C-CCA      • 
)*QS/Y5CMT) 
20  3     F4AT=C-CCAAL 

)*QS/Y5<  ^v.  ) 

0 


i-c  !  i  c    r>+c  iai. 


)  )  :    .j.  , 


!*T(tfT)*C   I*  L.l   :■  "-:(     D 


i  -  ;   f  ( i'.  T  )  *  E 1 A 
i  -C    O.l  >Vt£A 


T  +  i 


-  c  a  )  *  s  < 

AC  •  1  )»i0( 


TCi'i'i ) 
I  ( i    1  ) 


P05 
?06 
207 

20  8 
^09 
p  1 0 

1  1 

J]    r 

21.3 
214 

2  3  5 
?  3  f 

21  7 
f  1  f? 
PI  9 
P20 
221 
2PP 
£23 
PP4 

22  5 


C:     LiETTl    .''     1    j.    I  <  :  OUS    G]  A3   IEN1 

HT(MT)=    LAMC2)    *    F2T    +LAMC4)    *    F41     +    LAK<5> 

HAT(MT>=    LAMC2)    *F2AT    +    LAMC4)    *    F4AT 

IF    (MT.EQ . 1  )    GO    TO  '60 


C  :     SI  MP L E    I  MT H  GRA T 1 0 SS 
■-A.V'(P)    =    LAM<2) 
LA    (  ■'  )    =    .'.''   '<  '  ) 
LA  •'(  5)     =    LA  ■•:(  5) 
60    CO/OTZNI  ■ 


l*5T 


+ 

DL£ 

(: 

) 

rfc 

D'l 

+ 

DLA 

•  (/ 

) 

* 

E:T 

+ 

DLA 

*  (  F 

) 

;!< 

DT 

C:    SETTING    UP 

It         (    JMn.-J"    •    ]     ) 

S3=0  .0 

B FT A =0.0 

?D=0.0 

DO    65    MT=1>81 

51CMT)=0.0 

S2(MT)=0.0 

6S    GO-MTI   3UE 


INITIAL    n 

(  C     1  U    7  ' ) 


I'.RC  V  [ON    ALO  \fi.i    ,Sh  g; 


L'lH  i*:01  1  c 


1  ■ :  7 

:      -  Cs     :   T.MPL 

829  70    BN=0.0 

P30  DO    7P    J=    I18O 

231  BN=    BN    +    (HATCJ 

P3P  72    CONTI   -OF 

233  BNf=    BN    +    CTTF    * 

234  IF(  ITG.EiQ.l  )    GO 
p;j  5  BETA=B  sl/BD 


I  MTi  •'  i    '-i';' » < '  -J    FO 


)*HAT(J     )+HTCJ    )*HT(J     ))*DT 


CT    F 

•!  1  I     7 


40 


>■'■■'■ 

p  3  7 
238 
839 
2*0 
'  U 
2.1  P 

?/'/■ 
24S 
g46 
9  HI 
PAR 
P  '-  9 
250 
i 
< 

P53 
P5^ 
!  55 

- 

■  !  7 
258 
P59 
260 
P.«  1 
■{  f 
P63 
-  i  /i 
P*   ■■ 

267 


•;  v  ( 

271 

P7p 

273 

p  /  / 

*  F  1.  9 
-75 
276 
277 

278 
p  7  9 
280 

282 

>  p  3 

P  8  /• 

p  < :  u 

287 
288 

p  f3  :.•) 

•  .J 
P       ] 

29^ 
P  9  h 
P  '5 
29^ 
297 
298 
299 
300 


1  )     GOTO    80 


.  ;  '1  =s 


■  i  ro  76 

7^    DO    7  5    J=l *8i 
TTI  ( J)=TT< J) 
ATLC J)=AT< J) 
F.L1  C  J>=K]  C  J) 
,2<  J)-F2<  J) 
,(..l)-Ti      (J) 
•(  ,   >=Y2< J) 
YL/'(  J)=Y4<  J) 
CAL( J)=CA( J) 
C>JL(<J>=CN<\J) 
Gfi    : ( J)=CAT( J) 
SATLC J)=SATC J) 
YI  '-,(  J)=Y5C  J) 
f,L2<  J)=F?  (  J) 
FL4< J)=F     C J) 

7  5,  CO  .1  I  MUF 
DYL1F=I VI F 
DYL3F=DY3F 

f    !1  U..=  i  ODl 

[  J  '  i J  -  j   j]  >J 

TFL=fF 

CTL=CT 

YL1F=Y1F 

YL3F=Y3F 

7<     IT=1 

77     I F  C  I  \  .  i\! 

STEP«STEPO 

S3  =  -CTT1<     •:- 

i  i  L=0 

'  -     -  L=0  .0 
DO    79    J=l>81 
SI  (  ,))=-HTC  J)+BKT  V-^'l  (  J) 

:-'(  .J)--  C  <!>-:-  >.  •:  ■■<  v  ) 

'/   I    COX1   IivLE 
GOTO    «5 

80     IF    (IT«NE.ITMAX)    GO    TO 
Wail  f1  C  1  »600)     IT*  I?  MAX 
600    FORMA  T    C  4H  I  T=     >  I  8 
.8) 
GOTO    l/i7 

8  5    IiMDT=0 
FS=0  .0 

tfi=tfl+stp:f*S3 

DO    9  5    J=1j81 

TTI  C  J>=TTLC  J)+STEP*S  KJ) 
A  T  1  C  J  )  =  A  TL  (  J  )  +  S  T  E  P  *  S  2  (  J ) 
IFCATH J).GE.O«0)GOTO  86 
ATI ( J)=AT1C J) +2 .0*PI 

5  '■(      i 1 ( J) .LF.P.0*PI )G0    TO    87 
ATI  C  J)=AT1  (  .')-:-  .0*PI 

7     IFCTTIC J) .LE. 14400 .0)G0T0 
TTI  (  J>=14400»0 

i  n  >t=i  <n  t+1 

GOTO    ^1 

f    ■'     rF<  Tl  1  C  J)  »G  sJ-0  •ti)GOr!  0      •) 

TTI  <  J)=0  •!' 

INI  T=IiMrT+l 

9  1     FS=PS+TT1 < J)*DT 
9  5   CONTINUE 

IF    (FS.LE. 38500. 0>G0    TO    98 
DO    97    Jl=l*81 

TTI C  Jl )  =  38500 .0/FS*T I  1  (  Jl  ) 
97    C0N1  I  >JUE 

;>;rite(  i*700)    itg*it 


ITG#STFPl.*CTL 
6HIThAXs*  18,/'-!  TG  =  *  I 


> 6HS Tfc PI  =  > F 1 9 • 8  * 4HC TL  = 


89 


41 


301     700    F0RMATC6HT00    MU* 6HCF    f     &*  6HL    OSED^i   t'i  G=*  I8*3FIT  =  .»  It ) 

CIFGRATE    STEPPED    TRAJECTORY 

305  98    DO    105    J=1j5 

306  Y1CJ)=Y0(J)    . 

307  10  5    CONTINUE 

308  Cc  •■  =  ]!  '.7«  77-^0. 92*H 

309  OSC=0  . 1  734*  .00243*EXPC-r.334/H) 

310  DTl=TFl/80.0 

311  INDGO 

'J  1  P      I  AlDl  =0 

31  ?     Di      115    J=l.»81 
314    Y12CJ)=YIC2) 

31  5    Y14C  J)=YK  4) 

316  VMS=Y1  C2>**2  .O+Yl  C  45**2  «0 

317  V/*1=-SQRT<  VMS) 

318  QS=QSC*W3S 

319  MN«VM/CS 

320  TAU=ATAN2CY1C4)*Y1C2)) 

321  TAT1C J)=TAU-AT1  (J) 

322  AB=AB:  (  !':    ri  (  J)  ) 
.323. IFCAB.GT-PI )G0T0    117 

3P/i    ALP=AB 

32  5    GOTO    120 

326    11  7    ALP=?  .  O  *p  I  -Al ' 

7     ISO    DO    125    1-1*5 
32?      IFCTAT1C J) .EO.BC I) )GOTO    130 
3P.9    1  ?  ^    COiVl  )  sJI'F 

0    130     i  « 1 =IMD1 +1 

33  1     IFCTAT1  (  J)  »GE  .0  »0  .A^-TATH  <J)  .LF-PJ  )    GO'iO    13? 
?2    IFCTAT1 C J).LE.-PI)    GOTO    135 

333  F 1 1 C J)=SIMCAT1 Co) ) 

334  El  PC  J)=-C0SCAT1  (  J)  )' 
33  5    GOTO    140 

336  135    Ell C J)=-SItfCATlC J) ) 

337  El  PC  J)=C0SCAT1  ( J) > 

338  C  :     FORM  [iMG    CA1     A.\!D    CM     F'     SJ  ■  '.  i  ■ )  I 

339  140    ALP2=ALP*ALP 

340  ALP3=ALP2*A3 

341  *LP4=ALP'3*ALP 

342  ALn5=ALP4*ALF 

343  MN2=MN*Mitf 

344  m  v~-:v  M2*KN 

345  MN54=MW3*Mi.\i 
3/1^    MN5-MW4*MN 

347    CI  1 =CC0+CC1 *ALP+CC2*ALP2+CC3*ALP3+CC4*ALP4+CC5*ALP5 
-.,-  ;    Cl2=CC6+CCY*      i+CCi  P+Ci  J3+CC10*      i4+CCll*fci>i5 

CA1 C u)=Cl  !    =01  ■ 
"<50    Nl  ).  =NCO+NC  1  *ALP+MC2*ALP2  +  lMC3*ALP3  +  i>JC4*ALP4+MC'5*ALP5 

351  WlP  =  MC6  +  ivC7>!        +  JC  '-..J"-:-  U.    *3    '     +F,tv4*^C10+NCl  1  *MM5 

352  C\l(  J)=N1  1*M1P 
3  53    FM=CMCJ)*QS 
354    F  ^=CA]  C  J')*Q; 

3  »!      I  F  CFWY3  C5)     •  .     •     3  3!J3  -0)    C  OTO    1  J  3 
-^  56    IMDG=IMDG    +1 
357    3  1  3CAT I  C  J)  =C 0 4 (  A T i  C  <i )  ) 
■  5^    SAT1  (  .J)=  ;  i  -U        1  C.'i)  ) 
<5       Yl  5C  J)=Y1  C  5) 
3f,n    DY)  C  3  >=Y3  C!    x< 
?rtj     jv/i  fp).-((TTi(  J) -FA  )*CAT1  C«j)-F  i\]*El  1  C  J)  )/Yl  C5) 

362  Fl 2C J)=DY1  C2) 

363  DY1C3)=Y1<4) 

364  DY1C4)  =  (CTT1  CO)     -    FA)     *    SAT1C.J)     -    FN    *    E12CJ))     /    Y1C5)  42 

365  F14C J)=DY1(4) 


.366    DY1 ( 5)=-TTl C J)     /    8050.0 
367    IF(J    .E0»    81)    GOTO    11.5 

368 

369 

370  C:  SIMPLE  INTEGRATION 

371  Y1C  1  >  =  Y1  C  1  )  +  <DYK  t  >+DYl  (2)*DT1  /2  .0>*DT1 

372  "tl  CP)=Y1  (2)+DYl  CP..)*tf  ] 

373  YlC3>=YlC3>  +  CDYH3>+DYlC4)*DTi/2  .0)  :<1  1  1 

374  Y 1 <  4 ) = Y 1 ( 4 )  +  DY 1 < 4 ) * DT 1 

375  YK5)=    Yl < 5>+DYlC5)*DTl 
37f     1 ) 5    CONTI    n 

. 
378    C:    SETTING    TARGET    C00RD1  MAT)5 
37a    fl 71 =Y 1 T0  +  DY1 T*TF  1 
380    Y3T1  =Y3  rO+DY3"l  *TF  1 
■'  ■  i    C : 
38 p.    C  : 

i  -    oo^pnrj       n    <  -£]:   005  7 

CT!=      >  )     +      '  .     :■     C  (  .  1  (  1  ■)     -     ,  1      !)-:.••-:•(      i  (■)-;:''  i  )■•-      . 
■   I  'i     (  i  >     >  '    )      i'i-f--*  i  T*  I     FT  j.     T     i  )  ,?s  t  ■  i  G*C1  1 

386  800  FORMAT  C4HITG=*  I8*3HIT=*  18*  5HIiN0T=*  18*  5HI  ND1  =*  I*  ,  //,  -y 
F  1  9  . ;'  *  5H  I  Mf  G  =  j  I  8*  4HCT 1  =*  FT  9  .  P  ) 

387  IFCCT1  .GE.  CTL)  GOTO  130 

388  DO  125  Jl=l*81 
3*9  TTL< Jl )=TT1  ( Jl  ) 

390  ATLC Jl  )=AT3  C Jl  ) 

391  ELK  Jl  >=E1  1  C  J]  ) 
39?.    FL2C  J1)=E12CJ1  ) 

3  93    T A  TL  ( ,J  1  )  =  7 A  T 1  (  J 1  ) 

394  YL2C Jl >=Y12( Jl ) 

395  YL4( Jl >=Y14C Jl ) 
^96    CALC Jl )=CA1( Jl ) 

397  CNLC  J]  >sCNl  Col  ) 

398  CATLC Jl )=CAT1  ( Jl  ) 

399  SATL< Jl )=5AT1 ( Jl ) 

400  YL5C  Jl  >=Y1  5C  Jl  ) 

401  FL'-C  Jl  )=i-  l''(,Jl  ) 
"0?  FL4(  Jl  >=F1  n(  Jl  ) 
403  12  5    CONTIMUF 

40  4  INP11  =  IND1 

4Q5  INPGL=INDG 

40^  TFL -TFJ 

407  CTL    CT1 

408  STH °I  -STEP 

409  YLIF=Y1 ( 1 ) 
410"  YL3F=Y1(3) 

41 1  DYL1F=DY1< 1 ) 

412  DYL3F=DY1<3) 

413  ITL=IT 

414  GOTO  140 

4 1 ,5  1  3  'i  5TEP=S T EP/P  •  0 

416  IPC  STEP  .LT.  STEPM)  GOTO  145 

417  140  IT=IT+1 

418  GOTO  77 

419  145  WRITEC1*900)STEP*STEPM*ITL*CTL*ITG*STEPL 

420  900    FORMAT (  5HSTEP=*F1  9  «8*  6  [STEPM»>-F1  9  .8*  4HI  TL=*  18*  //*4HCTL=*F19  «3« 
4HITG=* I8*5HSTEPL=*F19.e ) 

421  147     IF(CTL.EQ.CT)    GOTO    2000 

422  00  1 50  Jl=l*81 
42  3  TTC Jl )=TTL( Jl ) 
4^4  ATC Jl )=ATL( Jl ) 

425  Y2( Jl )=YL2C Jl ) 

426  Y4( Jl )=YL4( Jl ) 

427  El( Jl )=EL1( Jl )  43 
' -  I  ESC  J]  >=EL2C Jl  ) 

429  TATC Jl )=TATL( Jl 5 


430  CA( Jl )=CAL( J] ) 
A3!  CMC  Jl  )  =C  JL(  Jl  ) 
A3?    CAT< Jl )=CATL( Ji ) 

433  SATC Jl )=SATL( Jl ) 

434  *5( J) )=YL5( Jl ) 

435  F2C  Jl  )^FL?.(  Jl  ) 

436  F4( Jl )=FL4C Jl ) 

43  7    150    CONTINUE 

438  TF=TFL 

439  BD=BM 

440  CT=GTL 

441  INDl=;INDiL 
448    INDG=INDGL 
/'/'.I    Y1F=YL1F 
444    Y3F=YL3F 

44  5    DYlFsDYLIF 

446  DY3F=DYL3F 

447  IF(ITG«GT.ITMAX)GOTO    2100 

448  ITG=ITG+1 

449  Y1T=Y1T0+DY1T*TFL 

450  Y3T=Y3T0+DY3T*TFL 

451  GOTO    v 

ii  58    8000    WF  I  TEC  1  *  ~>0P  )  I  TG 

453  90S    F0P.tMAT<6HN0    IMP>6HR0VEME*6HMT    P05*6HSIBLE    *6HFR0N    G> 
6HRADIEM*6HT    IN    T>6HHIS    DI*6HRECTI0#6HNj  *6HITG=       #18) 

454  C:     (NO    IMPROVEMENT    POSSIBLE    FROM 'GRADIENT    IN    THIS    DIRECTION) 

455  GOTO  5000 

456  8100  m?RITE<  U903) 

457  903  FORMAT* 6H IT6= I T#6HGMAX   ) 
45*  5000  STOP 

459  END 
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